MICROCOPY  RESOLUTION  TEST  CHART 


Au  A. 093487 


♦ 


HDL-CR-  80-384-1 
November  1980 


Fluidic  Heading  System  Study:  Summary  Report 
By  Abraham  Finkel 


Prepared  by 

The  Johns  Hopkins  University 
Applied  Physics  Laboratory 
Laurel ,  HD  20810 


Under  contract 

N00024-78-C-5384 


U.S.  Army  Electronics  Research 
and  Development  Command 

Harry  Diamond  Laboratoriea 

Adelphi,  MD  20783 


81  1 


0  6  00 7 


s 


The  findings  in  this  report  are  not 
to  be  construed  as  an  official  Department 
of  the  Army  position  unless  so  designated 
by  other  authorized  documents. 

Citation  of  manufacturers'  or  trade 
names  does  not  constitute  an  official  in¬ 
dorsement  or  approval  of  the  use  thereof. 

Destroy  this  report  when  it  is  no 
longer  needed.  Do  not  return  it  to  the 
originator. 


_ Unclassified _ 

SECURITY  CLASSIFICATION  OF  THIS  PAGE 


EPORT  DOCUMENTATION  PAGE 


-8^-384-1  \ 


PLEASE  FOLD  BACK  IF  NOT  NEEDED 
FOR  BIBLIOGRAPHIC  PURPOSES 


3.  RECIPIENT'S  CATALOG  NUMBER 


7.  AUTHOR(s) 


'  ,f;  Abraham  ^inkel  1 


9.  PERFORMING  ORGANIZATION  NAME  &  ADDRESS 

The  Johns  Hopkins  University 
Applied  Physics  Laboratory' 
Laurel ,  HD  20810 


II.  CONTROLLING  OFFICE  NAME  *  ADDRESS 

U.  S.  Army,  Harry  Diamond  Laboratories 
2800  Powder  Mill  Road 
Adelphi,  MD  20783 


14.  MONITORING  AGENCY  NAME  A  ADDRESS 


6.  PERFORMING  ORG.  REPORT  NUMBER 


16.  DISTRIBUTION  STATEMENT  ( of  ttlis  Report) 

Approved  for  public  release;  distribution 
unlimited. 


17.  DISTRIBUTION  STATEMENT  {of  the  mtrmcl  entered  m  Block  TO.  it  different  from  Report) 


10.  PROGRAM  ELEMENT.  PROJECT.  TASK 
AREA  &  WORK  UNIT  NUMBERS 

Prog.  Ele. :  62120A 
DRCMS :  612120H250011 


15a.  DECLASSIFICATION/DOWNGRADING 
SCHEDULE 

N/A 


r  ion  7 or 

i 

;  ORA&I 

-  .  i:  TAB 

|  l  - v>’v"incpd 
!  J  -..ii icatior 


18.  SUPPLEMENTARY  NOTES 

PRON:  1F9R0012011FA9 


19.  KEV  WORDS  (Continue  on  revert*  tide  if  memory  end  identify  by  block  number) 

Sensor,  heading  Navigation,  land 

Sensor,  fluidic  Vehicle,  armored 

Sensor ,  rate 


Distribution/ 
Availability  Codes 
Avail  and/or 


20  ABSTRACT  I Continue  on  revert*  tide  >1  necettery  end  identify  by  block  number f 

1  The  feasibility  of  incorporating  a  fluidic  angular  rate  sensor  into  a  ve¬ 
hicle  heading  sensor  system  is  investigated.  A  heading  sensor  of  this  type 
would  find  application  in  armored  vehicles  where  a  magnetic  compass  cannot  be 
used.  The  study  covers  system  considerations,  microprocessor-based  computa¬ 
tional  requirements,  and  the  effects  of  rate  sensor  errors.  ~ 


FORM 
t  JAN  73 


1473 


c  ■  j  o 


Unclassified 

SECURITY  CLASSIFICATION  OF  THIS  PAM 


THE  JOHNS  HOPKINS  UNIVERSITY 

APPLIED  PHYSICS  LABORATORY 

LAU»6l  MABVLANO 


CONTENTS 


1.  INTRODUCTION  . 

1.1  Statement  of  Task  . 

1.2  Principal  Conclusions  and  Recommendations  .  . 

2.  SYSTEM  CONSIDERATIONS  . 

2.1  Description  . 

2.2  Operation  . 

2.3  Microprocessor  . 

2.4  Integrator  . 

2.5  System  Limitations  . 

3.  COMPUTER  STUDIES  OF  SENSOR  REQUIREMENTS  . 

3 . 1  Purpose  . 

3.1.1  Long  simulated  (vehicle)  time  .  .  .  . 

3.1.2  Reasonably  short  computer  time  .  .  .  . 

3.1.3  Highly  accurate  attitude  updating  .  . 

3 . 2  Approach  . 

3.3  Program  Inputs  and  Outputs  . 

3.4  Tabulation  of  Results  . 

3.4.1  Z  axis  motion  only:  continuous  half 

sine  waves  of  90  deg  amplitude 
repeating  every  10  minutes  . 

3.4.2  Full  Scenario:  Three  Axes  Motion  .  . 

3.4.3  Full  scenario  changed  to  eliminate 

simultaneous  pitch  and  roll  (X 
motion  removed  during  1st  100 
seconds).  Therefore,  no  Z  axis 
coning  motion.  Sensor  error  as  in 
3.4.2(g)  . 

3.4.4  Full  scenario  changed  to  reflect 

higher  frequencies  as  shown  on 
charts  of  measured  pitch  and  roll  .  . 

3.4.5  Full  scenario  changed  to  include 

coning  motion  . 

3.4.6  Full  scenario  changed  to  test  for 

highest  frequency  pitch  and  roll  .  . 


3.5  Conclusions 


THC  JOHNS  HOSKINS  UNIVERSITY 

APPLIED  PHYSICS  LABORATORY 

LAUREL  MARVLANO 

CONTENTS  (Cont'd) 

Page 


4.  COMPUTER  STUDIES  OF  MICROPROCESSOR  BASED 

ALGORITHMS .  23 

4.1  Purpose .  23 

4.2  Approach . 23 

4.2.1  Reference  Program  .  23 

4.2.2  Test  Program .  24 

4.2.3  Plots  of  Outputs .  24 

4.3  Conclusions .  42 

5.  MEASUREMENTS  OF  SENSOR  CHARACTERISTICS  .  43 

6.  CONTRIBUTIONS  TO  SENSOR  ERRORS  .  47 

6.1  Offset .  47 

6.2  Asymmetry .  47 

6.3  Non-linearity .  48 

6.4  Hysteresis .  49 

6.5  Cross-Axis  Sensitivity  .  49 

6.6  Sensitivity  to  Linear  Acceleration  .  49 

6.7  Two- Axis  Quadrature  Vibration  .  49 

6.8  Rectification  of  Vibration  .  49 

ACKNOWLEDGMENT .  51 

REFERENCES .  53 

APPENDIX  A.— COMPUTATIONAL  ALGORITHM  .  55 

APPENDIX  B.— ALTERNATE  ALGORITHMS .  59 

APPENDIX  C.— "PRECISION"  MATRIX  UPDATING  USED  IN 

SECTION  3,  BODY  OF  REPORT .  61 

APPENDIX  D.— CONING  MOTION  AND  ITS  SIGNIFICANCE  ....  65 

APPENDIX  E.— PROGRAM  LISTING  FOR  SECTION  3, 

BODY  OF  REPORT .  71 

APPENDIX  F.— PRINTOUTS  FOR  SECTION  3 .  79 

APPENDIX  G.—  CHECK  ON  ACCURACY  OF  REFERENCE 

ALGORITHM .  105 

APPENDIX  H.—  PROGRAM  LISTINGS  FOR  SECTION  4 .  107 

DISTRIBUTION .  121 


* 


FIGURES 

Page 

1  Heading  sensor  system  block  diagram  .  10 

2  Pulse-rebalanced  integrator  .  12 

3  Heading  obtained  with  32-bit  computation  .  25 

4  Heading  error  obtained  with  32-bit  computation  .  .  26 

5  Heading  error  obtained  with  32-bit  computation 

(expanded  time  scale) .  27 

6  Heading  error  obtained  with  32-bit  computation 

(expanded  time  scale) .  28 

7  Tilt  angle  obtained  with  32-bit  computation  .  .  29 

8  Tilt  error  obtained  with  32-bit  computation  .  .  30 

9  Tilt  error  obtained  with  32-bit  computation 

(expanded  time  scale) .  31 

10  Tilt  error  obtained  with  32-bit  computation 

(expanded  time  scale) .  32 

11  Heading  obtained  with  24-bit  computation  ....  33 

12  Heading  error  obtained  with  24-bit 

computation .  34 

13  Heading  error  obtained  with  24-bit 

computation  (expanded  time  scale)  .  35 

14  Heading  error  obtained  with  24-bit 

computation  (expanded  time  schedule)  .  36 

15  Tilt  angle  obtained  with  24-bit  computation  .  .  37 

16  Tilt  error  obtained  with  24-bit  computation  .  .  38 

17  Tilt  error  obtained  with  24-bit  computation 

(expanded  time  scale) .  39 

18  Tilt  error  obtained  with  24-bit  computation 

(expanded  time  scale) .  40 

19  Tilt  error  obtained  with  24-bit  computation 

(expanded  time  scale)  . .  41 

20  Sensor  test  results .  44 

21  Nonsymmetrical  transfer  function  ...  .  47 

22  Nonsymmetrical  input  motion  .  48 


5 


7 


MBBK1B  P40S  ALAMMiOl 


TH*  JOHNS  HOMINS  UNIVCHS1TY 

applied  physics  laboratory 

LAUBCL  MABYLANO 


1.  INTRODUCTION 


1.1  Statement  of  Task 


The  purpose  of  this  study  was  to  investigate  the  fea¬ 
sibility  of  incorporating  a  fluidic  angular  rate  sensor  into  a 
heading  sensor  system.  The  fluidic  sensor  may  offer  a  cheap 
and  rugged  alternative  to  the  rate  gyro.  A  heading  sensor  of 
this  type  would  find  application  in  armored  vehicles  where  a 
magnetic  compass  cannot  be  used.  Goals  for  the  system  are 
low  production  cost  (<  $6,000)  and  a  drift  rate  of  0.8  deg 
per  hour,  although  a  higher  drift  rate  may  be  acceptable  in 
some  applications. 

1.2  Principal  Conclusions  and  Recommendations 

(a)  The  fluidic  sensor  (including  necessary  fluidic 
amplifiers)  demonstrates  sensitivity  of  the 
required  order  of  magnitude. 

(b)  Drift  characteristics  under  laboratory  condi¬ 
tions  are  encouraging. 

(c)  A  key  element  (a  transducer  which  converts 
pressure  to  an  electrical  signal  with  the 
necessary  stringent  requirements)  is  yet  to 
be  demonstrated  and  developed. 

(d)  Many  important  environment  characteristics 
are  yet  to  be  determined  with  precision. 

(e)  Essential  environmental  tests  should  be  applied 
to  an  integrated  sensor-transducer  package. 

(f)  Certain  effects  such  as  the  long-term  equivalent 
drift  under  vibration  are  best  measured  by  inte¬ 
gration  of  the  output.  A  high-quality  contin¬ 
uously  rebalanced  integrator  should  be  developed. 
An  integrator  of  this  type  will  likely  be  re¬ 
quired  to  furnish  angular  incremental  data  to 
the  computer. 

(g)  Modern  microprocessors  can  handle  the  computa¬ 
tion  burden.  Thirty-two  bit  precision  will  be 
required  with  a  sampling  frequency  of  about  100 
per  second. 

(h)  The  main  thrust  of  further  effort  should  be  di¬ 
rected  toward  the  construction  of  an  integrated 
sensor-transducer  package  before  conducting 
precision  environmental  tests. 
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2.  SYSTEM  CONSIDERATIONS 


2.1  Description 

For  a  vehicle  whose  orientation  is  perfectly  hori¬ 
zontal  (no  pitch  or  roll),  a  heading  may  be  obtained  by  simply 
integrating  the  angular  rate  of  the  vehicle’s  vertical  axis. 

Hence,  for  such  a  single  axis  system,  a  single  angular  rate 
sensor  is  sufficient.  With  pitch  and  roll  present,  large 
errors  would  result  and  it  is  necessary  to  measure  angular 
rates  about  all  three  vehicle  axes.  The  required  computa¬ 
tions  are,  of  course,  much  more  complex  and  are  briefly 
outlined  in  Appendix  A. 

At  some  point,  digitizing  is  required  so  that  computa¬ 
tion  may  proceed  with  the  necessary  accuracy.  It  would  be  pos¬ 
sible  to  sample  the  angular  rate  sensors  directly  and  enter  rates 
into  the  computer.  Noise  and  vibration  are  apt  to  make  this  ap¬ 
proach  unworkable  unless  strong  filtering  is  employed,  in  which 
case  vital  rate  information  may  be  lost.  Furthermore,  a  rate 
resolution  equal  to  the  desired  drift  rate  of  0.8  deg/hr 
(0.0002  deg/s)  is  required.  If  the  vehicle's  maximum  angular 
rate  is  40  deg/s,  an  18-bit  analog- to-digital  conversion  is 
implied  for  each  sample. 

A  more  practical  approach  utilizes  angle  increments  as 
the  basic  unit.  Angle  increments  are  obtained  by  integrating 
the  rate  sensor  output  and  sampling  the  integrator  output.  Rapid 
sampling  is  still  required  to  keep  the  increments  small,  since 
knowledge  of  varying  velocity  between  samples  will  be  lost.  The 
computational  algorithm  assumes  constant  velocity  between  samples, 
although  it  is  possible,  with  added  complexity,  to  estimate  accel¬ 
eration  and  higher-order  terms  utilizing  more  than  one  sample 
interval.  The  integration  which  takes  place  prior  to  digital  com¬ 
putation  effectively  filters  noise  and  properly  reacts  to  high- 
frequency  motion,  thus  giving  correct  angle  increments.  A  care¬ 
fully  constructed  pulse-balanced  integrator  can  circumvent  the 
need  for  18-bit  readout  while  maintaining  18-bit  sensitivity  to 
any  accumulated  angular  increments  by  virtue  of  the  memory  aspect 
of  the  integrator  capacitor.  The  features  of  this  type  of  circuit 
will  be  described  at  the  end  of  this  section. 

A  system  would  therefore  take  the  form  illustrated  in 
Figure  1. 
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Figure  1  Heading  sensor  system  block  diagram. 


The  transducer  need  not  be  limited  to  a  voltage  output  as  shown. 
The  integrator  block  would  be  modified  to  accommodate  other 
types.  In  particular,  if  a  pressure-to-frequency  transducer 
were  available,  the  integrator  would  simply  be  a  counter.  To 
the  extent  that  the  sensor-transducer  combination  cannot  be 
sufficiently  isolated  from  the  environment,  an  additional  data 
path  to  the  computer  is  shown  to  allow  for  proper  compensation. 
(Of  course,  transfer  functions  must  be  stable  and  known  with 
precision. ) 

2.2  Operation 

The  operator  will  put  the  computer  into  one  of  two 
modes:  ALIGN  or  NAVIGATE.  In  the  align  mode,  start-up  in¬ 
formation  must  be  fed  into  the  computer  so  that  it  can  calcu¬ 
late  initial  values  for  the  elements  of  the  attitude  matrix 
and  earth-rate  components.  Entry  could  be  made  via  either  a 
simple  keyboard  or  a  number  of  switches.  The  required  input 
data  are  latitude  and  pitch,  roll,  and  heading  angles. 

Latitude  must  be  known  so  that  the  effect  of  earth 
rate  may  be  properly  accounted  for.  Pitch  and  roll  angles  may 
be  read  from  gravity-sensitive  devices  (e.g.,  a  gimballed  plat¬ 
form  with  level  indicators).  Initial  heading  must  be  deter¬ 
mined  with  reference  to  a  known  direction.  Note  that  the  com¬ 
puter  will  not  properly  calculate  departure  from  an  arbitrarily 
defined  initial  heading.  The  absolute  heading  must  be  known 
to  enable  calculation  of  earth  rate  effects.  The  gyrocompass- 
ing  technique  of  determining  initial  alignment,  conventionally 
used  in  inertial  navigation  systems,  requires  very  accurate 
sensing  of  earth  rate  and  does  not  appear  to  be  within  reach 
for  the  present  fluidic  sensors. 
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With  the  initial  alignment  procedure  complete,  the 
stationary  vehicle  should  sense  no  motion  with  respect  to  the 
ground.  Nonzero  outputs  are  due  to  sensor  bias,  and  an  ob¬ 
servation  period  is  required  to  determine  the  magnitudes  (and 
rate  of  change,  if  uniform).  Bias  (and  bias  rate)  are  thus 
known  corrections  to  be  applied  during  the  NAVIGATE  mode.  Ad¬ 
vantage  could  be  taken  of  any  subsequent  vehicle  stops  to  obtain 
updates  on  the  sensor  bias. 

The  computer  is  switched  to  NAVIGATE  prior  to  the 
start  of  vehicle  travel.  Updating  of  the  attitude  matrix 
and  display  of  heading  then  proceeds  automatically. 

2 . 3  Microprocessor 

The  computational  requirements  for  one  particular  al¬ 
gorithm  are  outlined  in  Appendix  A.  Thirty-two  bit  precision 
is  required,  with  updating  at  a  rate  of  about  100/s.  A  16-bit 
microprocessor  is  a  logical  choice  with  the  possible  use  of  a 
hardware  multiplier  if  execution  time  must  be  improved.  Var¬ 
iations  from  a  basic  configuration  to  provide  various  compen¬ 
sations  will  not  have  major  impact  on  either  cost  or  execution 
time  (e.g.,  look-up  tables  to  modify  the  transfer  function).  A 
significant  simplification  could  be  made  if  no  compensation  at  all 
were  required,  for  then  power-of-two  angular  increments  could  be 
used  as  multipliers,  resulting  in  simple  shift  operations.  Some 
simplification  of  the  algorithm  may  also  be  possible  by  changing 
the  reference  coordinate  system,  as  described  in  Appendix  B. 

For  high-volume  production,  development  and  program¬ 
ming  costs  need  not  be  considered.  The  cost  of  a  fully  packaged 
microprocessor  with  the  program  contained  in  masked  read-only 
memory  (ROM)  will  probably  lie  in  the  $1-  to  $2-K  range.  As  an 
example,  a  prewired  and  assembled  Texas  Instruments  module 
(TM  990/101M)  containing  memory  is  available  for  $500  to  $600 
in  production  quantities.  The  microprocessor  component  alone 
(TMS  9900)  is  available  for  $30.  A  full-temperature  military 
version  (SBP  9900AM)  costs  $400. 

2.4  Integrator 


Considerable  dynamic  range  must  be  exhibited  at  the 
output  of  the  angular  rate  sensor.  The  sensor  must  be  capable 
of  responding  to  both  the  maximum  angular  rate  («  40  deg/s)  and 
the  allowable  drift  rate  (**  0.0002  deg/s),  a  range  equivalent 
to  18  bits.  However,  if  integration  precedes  the  computer, 
sampling  of  the  integrator  output  requires  only  that  the  readout 
resolution  be  sufficient  for  accurate  updating.  Thus,  if  10  ms 
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sampling  is  used,  the  maximum  angular  step  is  0.4  deg,  while  a 
resolution  of  0.04  deg  may  be  sufficient  provided  that  the  re¬ 
maining  angle  increment  less  than  0.04  deg  is  retained  and  added 
to  the  next  increment.  Despite  the  coarse  angle  readout,  there 
is  no  accumulation  of  errors.  These  properties  are  exhibited  by 
the  pulse-rebalanced  integrator  shown  in  simple  form  in  Figure  2. 


Figure  2  Pulse-rebalanced  integrator. 


The  integrator  output  represents  angle.  When  a  positive  or 
negative  threshold  equal  to  the  least  significant  readout 
bit  is  reached,  a  precision  pulse  is  generated  to  rebalance 
the  integrator.  The  change  of  integrator  output  voltage  due 
to  the  pulse  must  equal  this  resolution  angle.  The  pulses 
drive  a  counter  which  is  read  out  periodically  by  the 
processor. 

While  the  readout  need  only  consist  of  a  few  relatively 
coarse  bits,  the  bias  and  drift  at  the  integrator  input  must 
still  satisfy  the  18  bit  requirement.  This  is  readily  achiev¬ 
able  with  good  quality  modern  operational  amplifiers  and  care¬ 
ful  design.  Changes  of  components  or  charge  quantities  result 
in  scale  factor  errors.  Scale  factor  stability  of  0.1  to  1% 
is  tolerable  provided  that  such  changes  apply  uniformly  to  all 
segments  of  the  transfer  function.  Innovative  circuit  design 
will  be  required  to  guarantee  equal  scale  factors  for  positive 
and  negative  inputs  (**0.01%). 

This  circuit  is  in  reality  a  voltage-to-frequency 
converter  with  the  resulting  pulses  counted  to  develop  angle 
increments  and  will  be  necessary  to  accommodate  a  pressure- 
to-voltage  transducer.  If  a  pressure-to-frequency  transducer 
of  sufficient  accuracy  is  developed,  then,  of  course,  only  a 
counter  would  be  required. 
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2 . 5  System  Limitations 

The  heading  sensor  system  cannot  calculate  position 
unless  linear  velocity  (or  acceleration)  is  also  measured. 
Hence,  the  change  of  attitude  due  to  travel  over  the  earth's 
curved  surface  must  be  neglected.  * 

Travel  over  level  ground  of  70  miles  from  the  start¬ 
ing  point  results  in  an  apparent  tilt  of  1  deg.  Bias  errors 
also  develop,  since  the  effect  of  earth  rate  is  not  properly 
compensated.  In  particular,  a  north-south  travel  of  70  miles 
from  the  equator  will  cause  the  vertical  axis  to  sense  an 
uncompensated  rotation  rate  of  0.25  deg/hr. 

For  missions  of  up  to  three  hours,  therefore,  these 
errors  will  have  little  impact  on  system  accuracy. 
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PREC  BEING  PAGE  BUMC-NOT  FILMED 


3.  COMPUTER  STUDIES  OF  SENSOR  REQUIREMENTS 


3.1  Purpose 

It  is  relatively  easy  to  see  the  effects  of  sensor 
errors  in  a  single-axis  system.  A  scenario  of  angular  motion 
is  multiplied  by  the  normalized  transfer  function  of  the  sen¬ 
sor  (output  vs.  angular  rate).  The  product  is  integrated  over 
time  to  obtain  the  angle  output.  This  may  be  compared  to  the 
precise  angular  position  which  is  given  by  the  integral  of  the 
input  angular  motion.  Hence,  for  example,  a  perfectly  linear, 
stable  transfer  function  with  an  unanticipated  offset  of  1  deg/hr 
will  simply  accumulate  an  angular  error  at  the  rate  of  1  deg/hr, 
regardless  of  the  input  scenario.  Nonlinear  transfer  functions 
produce  additional  errors  which  are  scenario-dependent  due  to  a 
rectification  effect  which  is  equivalent  to  adding  additional 
bias  or  offset. 

For  the  full  3-axis  system,  there  will  be  additional 
errors  due  to  cross-coupling.  It  was  always  felt  that,  given 
a  system  which  is  not  allowed  to  produce  errors  greater  than, 
say  3  deg  (1  deg/hr  for  a  3  hr  mission),  the  3-axis  effects 
would  not  be  drastic  and  that  the  simple  one-axis  system  could 
be  the  basis  of  rule-of-thumb  requirements  on  the  sensors. 
However,  to  demonstrate  the  correctness  of  the  intuitive  con¬ 
clusions,  a  computer  simulation  was  performed.  This  simula¬ 
tion  allowed  for  sensor  bias  and  scale  factor  errors  only. 

"Bias"  should  be  considered  to  be  due  to  all  contributory 
factors:  unpredictable  offset,  the  effect  of  motion  scenario 
upon  an  asymmetrical  or  nonlinear  transfer  function,  and  the 
rectification  effects  of  vibration  (discussed  further  in 
Section  6). 

The  following  requirements  for  a  successful  computer 
analysis  are  somewhat  incompatible: 

3.1.1  Long  simulated  (vehicle)  time 

If  3-hr  missions  are  contemplated,  the  full 
3  hr  should  be  simulated.  Heading  error  may  grow  nonlinearly, 
and  it  would  be  incorrect  to  extrapolate  the  results  of  a 
shorter  run. 


3.1.2  Reasonably  short  computer  time 

If  a  multitude  of  runs  is  to  be  made  so  that 
many  factors  may  be  varied,  a  short  run  time  is  essential. 
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3.1.3  Highly  accurate  attitude  updating 

Typical  similar  computer  studies  derive 
"system"  errors  rather  than  errors  due  solely  to  sensor  de¬ 
ficiencies.  Contributing  to  these  system  errors  are  also 
the  approximation  errors  inherent  in  the  attitude-updating 
procedure.  Accuracy  is  obtained  by  high-frequency  updating 
which,  of  course,  requires  long  computer  runs  and,  even  then, 
roundoff  errors  may  become  a  factor. 

3 . 2  Approach 

The  foregoing  incompatible  requirements  may  be 
satisfied  through  a  slight  subterfuge.  The  underlying  ve¬ 
hicle  scenario  is  described  in  terms  of  sine  waves  (a  con¬ 
venient  mathematical  representation  is  needed  to  enter  3-hr 
worth  of  motion  into  the  computer).  These  sinusoidal  wave¬ 
forms  are  then  quantized  at  sampling  intervals  which  are 
short  enough  to  preserve  the  basic  nature  of  the  motion; 
i.e.,  many  samples  per  cycle.  It  is  this  quantized  motion, 
a  series  of  angular  steps,  which  then  becomes  the  assumed 
angular  motion  applied  to  the  vehicle.  Computer  updating 
need  be  performed  only  when  the  angular  steps  occur.  The 
three  principal  sources  of  computation  errors  are  either 
eliminated  or  minimized: 

(1)  There  is  no  varying  velocity  between  updates 
since  there  is  no  vehicle  motion  between  steps. 

(2)  The  solution  of  the  matrix  differential  equa¬ 
tion  required  by  the  updating  procedure  involves  a  matrix 
exponential.  In  the  normal  algorithm,  one  or  more  terms  of 
the  series  approximation  will  be  used.  With  a  large-scale 
computer  and  the  relatively  infrequent  updating  required 

by  the  quantized  motion,  an  exact  closed-form  solution 
may  be  used. 

(3)  Computer  roundoff  error  is  considerably 
reduced  due  to  the  reduced  frequency  of  updating. 

To  further  reduce  the  total  number  of  updates,  only 
angular  steps  exceeding  a  prescribed  minimum  are  allowed. 

If,  at  a  sampling  instant,  the  angular  step  were  less  than 
the  minimum,  no  step  at  all  would  be  allowed.  Thus,  if  the 
scenario  includes  long  periods  of  little  or  no  motion,  fewer 
compulations  are  made,  thereby  decreasing  both  the  errors 
and  computer  time. 
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As  described  elsewhere,  a  nine-element  direction 
cosine  (or  "C")  matrix  describes  the  vehicle  attitude.  In 
this  computer  program,  two  such  C  matrices  are  updated  at 
each  angular  step.  The  reference  matrix,  CREF,  describes 
the  actual  vehicle  attitude.  The  computed  matrix,  CCMP, 
describes  the  attitude  obtained  based  on  erroneous  data 
from  the  rate  sensors.  Since  heading  error  is  of  primary 
interest,  heading  is  calculated  from  each  of  the  matrices 
with  the  difference  tabulated  as  the  heading  error.  When¬ 
ever  an  angular  step  is  encountered,  the  following  three 
C-matrix  updates  are  performed: 

(1)  CCMP  is  updated  for  any  rotation  sensed  since 
the  previous  angular  step.  A  sensor  bias  will,  of  course, 
result  in  a  fictitious  rotation.  Also,  since  the  matrix  is 
misaligned,  earth  rotation  is  not  properly  compensated  for 
so  that  the  computer  thinks  there  has  been  some  net  motion 
with  respect  to  the  ground. 

(2)  CREF  is  updated  for  the  angular  step,  involv¬ 
ing  one,  two,  or  all  three  axes. 

(3)  CCMP  is  similarly  updated  for  the  angular  step. 

In  this  case,  the  angular  steps  reflect  the  erroneous  scale 
factors  assumed  for  the  angular  rate  sensors. 

The  exact,  closed-form  solution  of  the  matrix  differential 
equation  is  shown  in  Appendix  C,  along  with  an  equivalent 
formulation  convenient  for  computation. 

3.3  Program  Inputs  and  Outputs 

To  allow  flexibility  of  vehicle  scenario,  angular  mo¬ 
tion  of  each  of  the  three  axes  is  specified  in  terms  of  angular 
amplitude  and  period  for  each  of  four  successive  intervals. 

The  time  at  the  end  of  each  interval  may  also  be  selected.  Any 
number  of  iterations  of  the  four  time  intervals  may  be  chosen 
to  simulate  any  total  vehicle  time.  Additionally,  in  one  ver¬ 
sion,  a  steering  instability  (or  Z-axis  fluctuation)  was 
superimposed. 

The  program  as  written  also  allows  selection  of  lati¬ 
tude,  initial  heading,  sampling  interval,  minimum  angular  step, 
and  printout  interval. 

Output  quantities  tabulated  are  time,  heading,  tilt, 
and  heading  error.  Since  pitch,  roll,  and  yaw  are  independently 
specified,  the  resulting  attitude  is  fully  determined.  As 
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further  discussed  in  Appendix  D,  symmetrical  motion  about  the 
vehicle  axes  can  result  in  a  considerable  attitude  "creep.” 
The  tilt  readout  shows  whether  this  effect  is  getting  out  of 
hand,  resulting  in  an  unrealistic  scenario  although,  in  any 
event,  the  ability  of  the  computer  to  follow  with  acceptable 
error  is  the  concern  of  these  studies. 

The  final  two  columns  of  the  readout  are  labelled 
DETCREF  and  DETCCMP.  These  list  at  each  time  the  value  of 
the  determinants  of  the  respective  matrices.  For  many  of 
the  C-matrix  updating  procedures,  a  prime  concern  is  the  de¬ 
velopment  of  "skewness"  or  lack  of  orthogonality  as  updating 
proceeds.  A  property  of  an  orthogonal  matrix  is  that  the 
value  of  its  determinant  is  unity.  The  printout  of  DETCREF 
and  DETCCMP  is  one  way  of  checking  that  the  matrix  is  being 
updated  properly.  A  listing  for  this  program  is  given  in 
Appendix  E.  A  selected  number  of  computer  printouts  is 
reproduced  in  Appendix  F. 

3.4  Tabulation  of  Results 


A  quick  look  at  the  results  under  various  conditions 
may  be  obtained  by  examining  the  heading  at  the  end  of  3  hr. 
For  a  fair  comparison,  we  wish  to  exclude  that  portion  of  the 
error  which  is  simply  the  final  beading  excursion  multiplied 
by  the  scale  factor  error.  Thus,  if  at  a  heading  of  100  deg 
a  system  with  a  2%  scale  factor  error  shows  a  heading  error 
of  2  deg  (of  comparable  sign),  then  there  has  been  no  error 
accumulation.  The  latitude  is  45  deg  unless  otherwise 
indicated. 


3.4.1  Z-axis  motion  only:  continuous  half  sine  waves 
'of  90  deg  amplitude  repeating  every  10  minute's- 

(a)  Z  sensor  scale  factor  1.02;  1  deg/hr  bias 

accumulated  heading  error  after 
3  hr  ■  2.08  deg 

(b)  Z  sensor  bias  error  only  of  1  deg/hr 

heading  error  *  2.85  deg 

(c)  Z  sensor  bias  error  only  of  1  deg/hr; 
latitude  ■  0  de'g 

heading  error  ■  2.70  deg 

(d)  Z  sensor  bias  error  of  1  deg/hr; 
latitude  *  90  deg 

heading  error  *  3.00  deg 
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[shows  that  at  90  deg  LAT,  where  the  Z  axis 
is  aligned  to  the  earth's  spin  axis,  a  mis¬ 
alignment  due  to  Z-axis  rotation  does  not 
pick  up  additional  errors  due  to  earth  rate. 
Also,  the  computation  is  exact.] 

( e )  Z  sensor  bias  error  of  1  deg/hr ;  sampling  in¬ 
terval  reduced  from  1.0  to  0.5  s 

heading  error  ■  2.85  deg  (same  as  (b)) 

( f )  All  sensors  with  bias  of  1  deg/hr  and  scale 
factors  of  l.oST 

heading  error  ■  1.06  deg 
(change  of  *  2  deg  due  to  cross  axis  effects) 

(g)  Reduced  Z  amplitude  of  5  deg;  0.1  deg  angle 
no  sensor  errors 

heading  error  *  0 

(h)  Reduced  Z  amplitude  of  5  deg;  0.1  deg  steps; 

Z  sensor  bias  of  l  deg/Er 

heading  error  *2.85  deg  (same  as  (b)) 

( i)  Reduced  Z  amplitude  of  5  deg;  0.1  deg  steps; 

all  sensors  with  1  deg/hr  bias  and  scale 
fnctorii  of  IT 52 -  - 

heading  error  •  1.30  deg 

( j )  Full  Z  amplitude;  X,  Y.  Z  scale  factors 
l.ti^;  ft,  Y,  Z  biases  or  -1,  -1.  +1  deg/hr 

heading  error  -  2.91  deg 

(compare  to  (f);  this  choice  of  signs 
has  increased  error) 

3.4.2  Full  Scenario:  Three  Axes  Motion 

1st  100  s  -  X-10  deg  amplitude,  10  s  period 
Y"10  deg  amplitude,  11  s  period 
Za90  deg  amplitude,  1200  s  period 

next  100  s  -  no  Y  motion 

next  100  s  -  no  X  motion 

next  300  s  -  no  X  nor  Y  motion 

(pattern  repeats  every  600  s) 

1.0  s  sampling 

1.0  deg  minimum  angle  step 
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(a)  Z  sensor  bias  of  1  deg/hr 

beading  error  *  2.83  deg 

(almost  identical  to  3.4.1(b);  no  cross¬ 
axis  effect  with  perfect  X,Y  sensors) 

(b)  All  sensors  with  1  deg/hr  bias 

heading  error  *  1.84  deg 

(c)  Bias  errors  (X,  Y,  Z)  of  -1,  -1.  + 1  deg/hr 

heading  error  -  3.71  deg 

(d)  Scale  factors  of  1.02  on  all  sensors;  no 
bias 

heading  error  *  -1.07  deg 

(e)  Scale  factors  of  1.05  on  all  sensors;  no 
bias 

heading  error  *  -2.73  deg 

(f)  X.  Y.  Z  scale  factors  of  0.95,  0.95,  1.05, 
no  bias 

heading  error  -  -2.60  deg 

(g)  Combined  sensor  errors:  scale  factor  1.02 
and  bias  of  1  deg/hr  on  all  sensors 

heading  error  *  0.78  deg 

(Note:  (b)  +  (d)  »  0.77  deg) 

(h)  Combined  sensor  errors:  1.02  scale  factor 
on  all  sensors;  X,  Y.  Z  bias  of  -1,  -T7 

>1  deg/fir  ^  L 

heading  error  »  2.65  deg 

( i)  Repeat  of  (g)  with  minimum  step  of  0.5  deg 

heading  error  ■  0.97  deg 

( j )  Repeat  of  (g)  with  minimum  step  of  0.5  deg, 

0,5  s  sampling 

heading  error  »  0.97  deg 

3.4.3  Full  scenario  changed  to  eliminate  simultaneous 

pitch  and  roll  (X  motion  removed  during  1st  l66  s). 
Therefore,  no  Z  axis  coning  motion.  Sensor  errors 
as  in  3.412(g) 

heading  error  •  0.47  deg 
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3.4.4  Full  scenario  changed  to  reflect  higher  fre¬ 
quencies  as  shown  on  charts  of  measured  pitch 
and  roll 


A  chart  for  one  particular  vehicle  course  shows 
high  pitch  and  roll  amplitudes  of  10  deg  and  5  deg,  respectively. 
Those  motions  are  in  phase  with  a  period  of  2.5  s.  A  worst-case 
is  simulated  where  this  motion  continues  for  the  entire  3  hr.  A 
single  half-sine  wave  of  yaw  having  d0  deg  amplitude  and  a  200-s 
half-period  is  assumed  every  600  s.  In  addition,  a  yaw  fluctu¬ 
ation  or  steering  wander  is  assumed  to  be  continuously  present 
with  3  deg  amplitude  and  a  3  s  period.  The  sampling  interval 
is  reduced  to  0.3  s  to  accommodate  these  higher  frequencies. 

(a)  Z  sensor  bias  of  1  deg/ hr 

heading  error  *  2.90  deg 
(compare  to  3.4.2(a)  *  2.83  deg) 

(b)  Z  sensor  scale  factor  1.02 

heading  error  -  -1.48  deg 

(c)  X,  Y,  Z  bias  errors  of  -1,  -1,  +1  deg/hr 

heading  error  ■  3.63  deg 
(compare  to  3.4.2(c)  •  3.71  deg) 

( d)  Combined  sensors  errors :  scale  factor 
1.02  and  bias  of  1  deg/hr  on  all  sensors 

heading  error  ■  2.35  deg 
(compare  to  3.4.2(g)  »  0.78  deg) 

3.4.5  Full  scenario  changed  to  include  coning  motion 

Since  in-phase  motion  does  not  produce  the  ser¬ 
ious  coning  effects  of  quadrature  motion,  the  roll  (Y)  period 
was  changed  to  2.6  s,  thereby  giving  a  continuously  varying 
phase  difference  between  X  and  Y.  There  is  now  considerably 
greater  creep  of  the  vehicle  both  in  heading  and  tilt.  (See 
discussion  of  this  effect  in  Appendix  D).  While  somewhat  un¬ 
realistic,  the  heading  sensor  system  should  still  be  able  to 
follow  with  reasonably  small  error. 

(a)  Z  sensor  bias  of  1  deg/hr 

heading  error  *  2.89  deg 

(b)  Scale  factor  1.02,  bias  of  1  deg/hr  on  all 
sensors 

heading  error  *4.58  deg 
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(c)  Repeat  of  Cb)  but  with  steering  wander 
removed 

heading  error  *  4.70  deg 

3.4.6  Full  scenario  changed  to  test  for  highest  fre¬ 
quency  pitch  and  roll 

Most  of  the  measured  vehicle  motion  shows  pitch 
and  roll  motion  of  3  deg  amplitude,  1.5  s  period.  An  additional 
program  was  run  with  continuous  X  axis  and  Y  axis  motion  of 
3  deg  amplitude  and  periods  of  1.5  and  1.6  s,  respectively. 

Yaw  motion  remained  as  in  3.4.4.  The  sampling  interval  was 
further  reduced  to  0.2  s.  With  scale  factors  of  1.02  and 
biases  of  1  deg/hr  on  all  axes: 

heading  error  -  1.80  deg 


3 . 5  Conclusions 


The  data  substantiated  the  tentative  conclusion  stated 
earlier;  namely,  that  for  systems  with  allowable  errors  of  only 
a  few  degrees,  the  contributions  of  cross-axis  effects  will  be 
minor.  In  none  of  the  cases  where  scale  factor  errors  were 
limited  to  2%  did  the  heading  error  after  3  hr  exceed  the 
simple  single-axis  calculation  by  more  than  2  deg  (single-axis 
heading  error  ■  Z-axis  bias  times  3  hr).  A  case  of  5%  scale 
factor  errors  (2e)  did  produce  a  heading  error  of  2.73  deg, 
but  a  5 %  scale  factor  error  may  already  be  considered  intol¬ 
erable,  since  the  heading  will  always  be  in  error  by  5%  X 
angular  excursion.  Thus,  anytime  the  vehicle  has  turned 
180  deg,  an  error  of  9  deg  will  be  encountered. 

The  foregoing  analyses  included  only  two  of  many  types 
of  sensor  errors:  bias  and  scale  factor.  Some  other  types  of 
sensor  errors  such  as  asymmetry  and  nonlinearity  may  be  examined 
in  terms  of  bias  and  scale  factor  (see  Section  6).  The  effects 
of  g-sensitivity  could  be  entered  into  this  program  if  a  realistic 
profile  of  vehicle  acceleration  could  be  modeled. 
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4.  COMPUTER  STUDIES  OF  MICROPROCESSOR  BASED  ALGORITHMS 


4.1  Purpose 

The  results  of  Section  3  indicate  heading  errors  due 
to  various  combinations  of  sensor  errors  and  scenarios,  pro¬ 
cessed  by  near-perfect  computations.  This  section  addresses 
the  corollary  question:  Assuming  perfect  sensors,  will  a 
practical  microprocessor  achieve  the  desired  accuracy?  The 
algorithm  utilized  requires  periodic  updating  of  the  nine- 
element  direction  cosine  matrix  as  described  in  Appendix  A. 
Alternate  computational  techniques  were  not  considered  since 
feasibility  rather  than  optimization  was  the  objective. 

4.2  Approach 

4.2.1  Reference  Program 

As  in  Section  3,  an  appropriate  scenario  must 
be  selected  since  errors  will  be  scenario-dependent.  Follow¬ 
ing  somewhat  the  procedures  used  in  that  section,  a  basic  600  s 
time  span  was  divided  into  intervals  of  192  and  408  s.  A  yaw 
motion  of  a  full  half  sine  wave  (amplitude  *  1.5  radian  and 
period  ■  384  s)  is  imposed  during  the  first  192  s,  followed  by 
no  yaw  during  the  balance  of  the  600-s  span.  Throughout  the 
600-s  span,  sinusoidal  pitch  and  roll  motions  of  0.06  radian 
amplitude  are  assumed.  The  pitch  and  roll  periods  are  1.5  and 
1.6  s,  respectively.  As  noted  in  Section  3,  a  choice  of  slightly 
different  pitch  and  roll  frequencies  allows  varying  phase 
relat ionships. 


A  reference  program,  referred  to  in  the  program 
listing  as  the  tank  simulation  program  (TNKSIM) ,  accepts  the 
foregoing  scenario  and  generates  heading,  tilt,  and  a  record  of 
angular  increments  to  be  sensed  by  the  physical  sensors,  with 
earth  rate  accounted  for.  These  angular  increments  are  subse¬ 
quently  used  as  the  inputs  tu  the  "test"  program.  Due  to  the 
lengthy  time  required,  the  program  allows  for  follow-on  runs 
to  previous  records  by  reading  the  last  attitude  matrix  as  a 
starting  point.  A  succession  of  such  runs  provided  a  record 
of  30-min  of  vehicle  travel. 

Since  maximum  accuracy  is  an  objective  of  the 
reference  program,  calculations  proceed  with  full  precision  and 
with  2  ms  updating.  A  second-order  algorithm  (see  Appendix  A) 
was  utilized  with  parallel  updating  (wherein  all  values  of  the 
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present  instant  are  obtained  solely  from  values  of  tbe  previous 
instant).  Skewness  of  the  attitude  matrix  was  monitored  by 
printing  the  value  of  its  determinant.  After  30  min,  a  departure 

—8 

from  unity  of  2  x  10  was  obtained.  A  further  test  of  the  ref¬ 
erence  algorithm  accuracy  is  described  in  Appendix  G. 

4.2.2  Test  Program 

In  this  program  (TNKTST),  the  reference  record 
is  the  source  of  sensor  inputs.  The  program  models  the  pulse- 
balanced  integrator  to  develop  periodic  angular  increments  which 
are  then  used  as  the  source  of  updating.  A  second-order  algo¬ 
rithm  identical  to  that  used  for  the  reference  program  is  used, 
except  that  now  computational  limitations  are  intentionally 
inserted.  For  the  two  sets  of  runs  completed,  precision  of 
32  and  24  bits  were  selected.  In  both  cases,  a  10-ms  update 
interval  was  used,  coupled  with  an  integrator  threshold  (least 
significant  bit)  of  0.06  deg.  Heading  and  tilt  are  calculated 
and  compared  to  the  reference  to  obtain  errors. 

4.2.3  Plots  of  Outputs 

Plots  of  heading,  tilt,  heading  error,  and  tilt 
error  were  obtained  by  further  sampling  of  the  computed  outputs. 
To  plot  30  min  of  data  requires  a  sampling  frequency  well  below 
the  frequency  of  the  fine  structure.  Therefore,  care  must  be 
exercised  in  interpreting  fine  structure  of  the  plots  (as  well 
as  the  more  frequently  sampled  data  available  in  printouts). 

The  low-frequency  components  are  of  much  more  significance. 

Figures  3  through  11  were  obtained  with  32  bit 
computation.  Heading  (as  obtained  by  the  32  bit  processor)  and 
heading  error  for  the  entire  30  min  are  shown  in  3  and  4.  Ex¬ 
panded  plots  of  part  of  the  error  record  are  shown  in  5  and  6. 

The  effect  of  the  0.06  deg  integrator  threshold  is  clearly  seen. 
Calculated  tilt  angle  for  the  entire  period  is  shown  in  7.  Tilt 
error  for  the  entire  period  is  shown  in  8,  with  expanded  plots 
in  9  and  10. 


Figures  11  through  19  are  similar  to  the  pre¬ 
vious  plots,  except  for  24-bit  computation.  Figure  16  (as  well 
as  Figure  8)  seems  to  show  a  discontinuity  at  200  s.  The  ex¬ 
panded  plot  of  19  demonstrates  that  this  is  merely  a  quirk  of 
insufficient  resolution  coupled  with  the  piecewise  construction 
of  the  scenario.  The  apparently  missing  2-deg  fluctuations  are 
now  made  visible. 


THE  JOHNS  HOPKINS  UNIVERSITY 

APPLIED  PHYSICS  LABORATORY 

-*u«eu  ma«v».a*o 


r 


S33H03G  MI  0NI0V3H 


Heading  error  obtained  with  32  bit  coniputat 


Figure  5.  Heading  error  obtained  with  32  bit  computation  (expanded  time  scale). 
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Figure  7.  Tilt  angle  obtained  with  32  bit  computation. 


Figure  9.  Tilt  error  obtained  with  32  bit  computation  (expanded  time  scale). 
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Figure  12.  Heading  error  obtained  with  24  bit  computation 
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Tilt  error  obtained  with  24  bit  computation  (exp 


Figure  18.  Tilt  error  obtained  with  24  bit  computation  (expanded  time  sea 


Figure  19.  Tilt  error  obtained  with  24  bit  computation  (expanded  time  scale) . 
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4.3  Conclusions 


The  choice  of  10  ms,  second-order  updating  with 
32-bit  precision  is  demonstrated  to  be  quite  adequate.  No 
significant  long-term  trend  in  heading  error  can  be  detected. 

The  more  sensitive  tilt  error  shows  a  gradual  growth  to  0.2 
deg  after  30  min.  The  sine  wave  pattern  of  heading  excur¬ 
sions  during  periods  of  no  yaw  motion  as  seen  in  Figure  3  is 
a  result  of  the  coning  phenomenon  (see  Appendix  D).  The  di¬ 
rection  and  rate  of  change  of  heading  continuously  change  as 
the  pitch  and  roll  phase  relationship  varies. 

A  reduction  to  24  bits  shows  a  significant  deteriora¬ 
tion.  In  addition  to  no  longer  accurately  following  the  90  deg 
yaw  excursions,  a  steady  error  accumulation  to  1.5  deg  at  30  min 
is  apparent.  The  tilt  error  is  a  full  16  deg  at  30  min. 

A  further  comparison  may  be  made  of  the  determinants 
for  the  two  cases.  For  the  32-bit  case,  the  determinant  of  the 
attitude  matrix  at  the  end  of  30  min  was  0.99935.  For  the 
24-bit  case,  the  determinant  equalled  0.8529,  a  considerable 
departure  from  the  ideal  unity. 

Ten  minutes  worth  of  data  was  also  obtained  from  a 
test  of  32-bit,  first-order  processing.  While  no  serious 
heading  errors  had  yet  developed,  the  determinant  at  the  end 
of  10  min  was  a  horrendous  1.45.  It  is  safe  to  conclude  that 
10  ms.  first-order  processing  is  unsatisfactory. 

Computer  program  listings  for  Section  4  are  given  in 
Appendix  H. 
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5.  MEASUREMENTS  OF  SENSOR  CHARACTERISTICS 


In  addition  to  the  studies  of  a  heading  sensor  system  which 
would  incorporate  a  fluidics  angular  rate  sensor,  a  concurrent 
measurement  effort  was  undertaken  with  joint  participation  of 
APL  and  HDL  personnel.  These  measurements  were  aimed  at  key 
fluidics  sensor  characteristics. 

The  tests  were  performed  under  admittedly  benign  laboratory 
conditions,  but  demonstration  of  feasibility  of  the  existing 
sensor  design  was  the  immediate  objective.  As  noted  elsewhere 
in  this  report,  the  successful  development  of  a  heading  s’ensor 
with  a  1  deg/hr  drift  requires  extremely  accurate  measurement 
of  angular  rate  inputs.  Whether  or  not  the  angular  rate  sensor 
will  meet  these  objectives  must  await  the  construction  of  a  com¬ 
bined  sensor-transducer  package  which  can  then  be  subjected  to 
precision  testing  under  a  variety  of  environmental  conditions. 

Measurement  of  angular  rate  was  made  via  three  stages  of 
fluidic  amplification  and  a  Barocel  pressure  transducer.  Data 
were  recorded  on  an  X-Y  plotter.  Angular  rates  were  obtained  with 
a  rate  table.  Standard  laboratory  air  was  used  as  the  power 
source  with  different  venting  arrangements.  (A  single  output 
port  reduces  the  ambient  noise  effects.) 

Pertinent  data  from  cns  set  of  tests  are  reproduced  as 
Figure  20.  An  operating  point  of  13  mm  Hg  was  selected  as 
being  least  sensitive  to  supply  pressure  fluctuations. 

The  transfer  function  of  output  pressure  change  versus 
angular  rate  was  0.05  mm  Hg  per  deg/s.  The  response  to  angu¬ 
lar  rate  excursions  of  ±0.02  deg/s  is  shown  on  Plot  2  of  Fig¬ 
ure  20.  Plot  3  shows  a  very  discernible  response  to  ±0.002 
deg/s.  Thus,  the  equivalent  of  earth  rate  (0.004  deg/s)  can 
be  seen  by  the  sensor.  To  achieve  the  desired  goal  of  0.8 
deg/hr,  a  sensitivity  of  0.0002  deg/s  is  required.  Since 
it  is  expected  that  rate  signals  will  drive  an  integrator, 
it  is  the  long-time  integral  which  must  be  sensitive  to 
rates  of  0.0002  deg/s.  Hence,  even  if  such  signal  levels 
at  the  X-Y  plotter  would  appear  to  be  submerged  in  noise, 
conclusions  about  sensitivity  for  this  application  are 
premature  unless  suitable  instrumentation  is  employed. 

Plot  4  shows  one  measurement  of  a  second  key  character¬ 
istic;  namely,  offset  drift.  The  offset  appears  to  have 
changed  by  the  equivalent  of  a  rate  change  of  0.001  deg/s 
over  24  min  or  a  drift  rate  of  9  deg/hr/hr.  In  a  simple 
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Figure  20.  Sensor  test  results. 
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single-axis  system,  the  angle  is  simply  the  integral  of  the 
rate.  Hence,  the  error  would  be  4.5  deg  after  1  hr  and 
40.5  deg  after  3  hr.  If,  in  a  final  system,  constant  drift 
rates  are  experienced  and  can  be  accurately  determined  during 
an  alignment  period,  suitable  compensation  can  be  obtained 
within  the  processor.  If  offset  changes  cannot  be  predicted, 
their  magnitudes  would  have  to  be  further  reduced. 

It  should  be  noted  that  an  available  sensor  was  used  as 
the  basis  for  these  tests.  A  potential  for  improvement  exists 
by  optimizing  the  sensor  design  for  the  specific  application 
at  hand.  (For  example,  the  present  high  angular  rate  capability 
may  be  relaxed. ) 
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3.  CONTRIBUTIONS  TO  SENSOR  ERRORS 


Results  of  the  computer  simulations  given  in  Section  3 
demonstrate  that  the  limitations  on  rate  sensor  errors  can  be 
estimated  by  considering  only  a  single-axis  system.  Hence, 
for  a  1  deg/hr  heading  drift,  the  angular  sensor  should  have 
an  unpredictable  (and  hence  uncompensated)  bias  of  approxi¬ 
mately  the  same  magnitude  or  less.  A  general  requirement  may 
be  stated  as  follows:  the  total  effect  of  all  sensor  deficien¬ 
cies  should  produce  an  output  which,  on  the  average,  tracks  the 
input  angular  rate  with  an  error  no  greater  than  the  desired 
heading  drift.  Many  of  the  contributory  factors  will  be  scenario 
dependent.  The  "bias"  of  Section  3  should- be  recognized  as  the 
effective  sum  of  many  error  sources. 

6.1  Offset 


Any  unpredictable  or  unexpected  shift  of  the  null  point 
is,  of  course,  a  bias  in  the  sense  of  Section  3.  This  offset,  in 
turn,  may  be  the  result  of  uncompensated  temperature  or  pressure 
changes  within  the  angular  rate  sensor  or  transducer. 

6.2  Asymmetry 

In  Section  3,  it  was  shown  that  scale  factor  errors 
of  one  percent  or  so  would  be  tolerable.  However,  should  there 
be  a  lack  of  symmetry  of  the  transfer  function,  rectification 
of  input  motion  results  in  a  bias,  as  shown  in  Figure  21. 


Figure  21  Nonsymmetricaf  transfer  function. 
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If  the  input  motion  is  sinusoidal  with  a  6  deg  peak-to- 
peak  amplitude,  then  6  deg  represents  the  integral  of  a  half  sine 
wave  of  the  corresponding  angular  rate  waveforms.  If  positive 
and  negative  scale  factors  differ  by  1 %,  then  a  0.06  deg  error 
is  generated  every  cycle.  For  motion  with  a  1.5  s  period,  the 
equivalent  "bias"  is  145  deg/hr.  Therefore,  considerably  better 
matching  of  positive  and  negative  characteristics  (of  the  order 
of  0.02%)  is  required  (after  compensation). 

6 . 3  Nonlinearity 

A  similar  rectification  effect  can  be  produced  from 
a  nonlinear  transfer  function,  even  if  symmetry  is  maintained, 
because  of  nonsymmetrical  input  motion. 


Figure  22  Nonlinear  transfer  function. 

One  can  readily  visualize  a  vehicle  drifting  slowly  in  yaw  which 
is  periodically  corrected  by  the  driver  as  illustrated  in  Fig¬ 
ure  22.  The  drift  is  long  and  slow;  the  correction  short  and 
fast.  For  the  vehicle  to  maintain  its  average  direction,  the 
integration  of  the  input  waveform  must  equal  zero.  But  the 
integral  of  the  output  waveform  delivers  a  "bias"  to  the  com¬ 
puter  by  virtue  of  the  unequal  positive  and  negative  scale  fac¬ 
tors.  If  a  5  deg  drift  were  corrected  every  five  seconds,  a 
nonlinearity  of  1%  gives  an  angular  error  of  0.05  deg  every 
five  seconds  or  an  equivalent  "bias"  of  36  deg/hr. 

It  will  be  noted  that,  insofar  as  certain  character¬ 
istics  such  as  non-linearity,  hysteresis,  g-sensitivity  are 
concerned,  the  specification  for  an  acceptable  sensor  is  inti¬ 
mately  related  to  the  profile  of  vehicle  motion.  For  the  sen¬ 
sor  to  operate  acceptably  under  all  possible  conditions,  the 
angular  rate  error  would  have  to  be  limited  to  the  desired 
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drift  rate  independent  of  input  motion.  Hence,  for  a  1  deg/hr 
sensor  (=  0.0002  deg/s),  and  a  maximum  rate  of  40  deg/s,  the 
nonlinearity  must  be  limited  to  0.0005%  of  full  scale.  Since 
maximum  rate  is  not  encountered  frequently,  such  a  requirement 
is  much  too  stringent.  (The  maximum  angular  rate  corresponding 
to  the  example  of  3  deg,  2.5  Hz.  motion  is  12  deg/s).  The  simple 
examples  given  here  to  illustrate  the  effects  of  asymmetry  and 
nonlinearity  indicate  that  0.01%  would  be  more  realistic. 

6.4  Hysteresis 

Any  memory  exhibited  by  the  device  can  result  in  an 
effective  bias,  again  depending  on  the  vehicle  scenario.  Ide¬ 
ally,  the  output  of  the  sensor  as  a  function  of  past  history 
should  vary  by  less  than  the  desired  drift  rate. 

6 . 5  Cross-Axis  Sensitivity 

Obviously,  the  sensor  should  not  produce  outputs  for 
angular  motion  about  any  but  its  designated  input  axis.  To  the 
extent  that  this  effect  can  be  measured  and  is  repeatable, 
compensation  can  be  introduced  into  the  processor. 

6.6  Sensitivity  to  Linear  Acceleration 

If  the  sensor  is  g-sensitive,  errors  due  to  gravity 
can  be  compensated  for  since  the  attitude  is  always  known  in 
the  computer  (not  without  penalty,  however;  such  additional 
computations  will  take  additional  time).  Without  accelerometers 
as  part  of  the  system,  there  would  be  no  way  to  compensate  for 
errors  due  to  vehicle  acceleration.  A  detailed  computer  run 
of  the  type  of  Section  3  could  be  made  for  a  vehicle  scenario 
of  three-axis  acceleration. 

6.7  Two-Axis  Quadrature  Vibration 

If  two  axes  of  the  vehicle  undergo  quadrature  motion, 
the  third  axis  will  show  an  effective  rotation  which  is  not 
sensed  by  the  third  axis  sensor.  This  is  the  coning  effect 
which  must  be  properly  handled  by  the  computational  procedures. 
Now,  should  the  two  axes  experience  quadrature  vibration  which 
is  not  true  vehicle  motion,  the  computer  will  erroneously  cal¬ 
culate  a  third-axis  rotation  which  never  takes  place.  This 
vibration  must  be  slow  enough  to  be  seen  at  the  sampling 
intervals  ( *  10  msec). 

6.8  Rectification  of  Vibration 


Another  vibration  effect  occurs  when  vibrational 
motion  is  accompanied  by  vibrational  tilt,  resulting  in  a 
rectification  effect. 
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The  effects  of  vibration  may  be  reduced  via  shock¬ 
mounting  of  an  integrated  3-axis  sensor  package.  The  attitude 
of  the  package  rather  than  the  vehicle  is  tracked,  allowing 
momentary  insignificant  vehicle  heading  errors  with  no  error 
accumulation.  Small  angular  differences  between  the  sensor 
package  and  the  vehicle  would  be  of  some  concern  if  an  attempt 
were  made  to  combine  a  vehicle  speedometer  with  the  heading 
sensor  to  obtain  position. 
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APPENDIX  A.— COMPUTATIONAL  ALGORITHM 


This  section  briefly  outlines  the  computational  algorithm 
needed  to  continuously  track  a  vehicle  heading.  No  attempt  was  . 
made  in  this  study  to  determine  an  optimum  approach.  Rather, 
the  purpose  of  this  phase  of  the  study  was  to  demonstrate  fea¬ 
sibility.  Accordingly,  the  popular  direction-cosine  matrix 
technique  was  used,  neglecting  other  possibilities  (such  as 
the  use  of  quaternions)  described  in  the  literature* •  2 . 

With  such  a  feasibility  demonstrated,  development  efforts 
could  be  concentrated  upon  the  input  sensor  and  transducer. 
Feasibility  consists  of  demonstrating  acceptably  small  errors 
when  the  algorithms  are  limited  to  the  capabilities  of  a  modern 
microprocessor.  Any  marginal  speed  problems  can  be  safely  ne¬ 
glected  since  it  is  a  small  matter  to  add  a  hardware  multiplier. 

The  direction  cosine  matrix  is  a  nine  element  matrix  which 
fully  describes  the  attitude  of  the  vehicle  with  respect  to  the 
local  (or  navigation)  frame.  Each  element  is  the  cosine  of  the 
angle  between  a  pair  of  axes. 


NAV 

Axes 


Vehicle  Axes 


X 

Y 

Z 

X' 

C11 

C12 

C13 

Y' 

C21 

C22 

C23 

Z' 

C31 

C32 

C33 

X,  Y,  and  Z  are  the  longitudinal,  transverse,  and  vertical 
axes  of  the  vehicle.  For  a  right-hand  system,  positive  di¬ 
rections  are  taken  as  forward,  right,  and  down.  X',  Y' ,  Z' 
are  the  corresponding  local  frame  axes  and  are  chosen  to  co¬ 
incide  with  north,  east,  and  down*,  respectively.  Any  vector 
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•Toward  the  center  of  the  earth. 
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in  the  vehicle  frame  may  be  transformed  to  a  vector  in  the 
NAV  frame  by  premultiplying  by  this  direction  cosine  matrix 


(C?>. 


So  defined,  the  elements  and  C2^  give  the  north  and 

east  components,  respectively,  of  the  vehicle's  longitudinal 
axis.  Therefore,  heading  may  be  extracted  from  the  C-matrix 
by  computing  the  arc  tangent  of  The  more  difficult 

task  is  the  accurate  updating  of  the  C-matrix  as  angular  in¬ 
crements  over  a  sample  period  are  developed  from  the  angular 
rate  senfeors. 


The  rate  of  change  of  the  C-matrix  is  given  by 


CW, 


(1) 


where  W  is  a  matrix  describing  the  angular  rates  of  the  vehicle'; 
axes,  x,  y,  z: 


w 


-z 

0 

x 


(2) 


For  constant  velocity,  the  solution  for  C  at  any  time  t  is 

Wt 


C(t)  -  C(o)e 


th 


or,  in  terms  of  samples  every  n  instant, 


Cn+1  =  Cn  e 


WAt 


(3) 


The  matrix  WAt  is  now  a  matrix  of  angular  increments  rather  than 
angular  rates. 


The  exponential  term  may  be  expressed  as  an  infinite  series 
leading  to 
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'n+1 


=  C 


I  +  WAt  + 


(WAt)' 


(4) 


wi^ere  I  is  the  identity  matrix. 

The  microprocessor  is  thus  required  to  update  the  most 
recent  C-matrix  after  each  sampling,  with  summation  and  matrix 
multiplication  as  indicated  by  equation  (4).  If  only  the  terms 
I  and  WAt  are  used,  the  process  is  simple  first-order  updating. 

2 

Greater  accuracy  is  obtained  by  including  the  term  - -  ,  re¬ 
ferred  to  as  second-order  updating.  " 

Prior  to  updating  per  equation  (4),  a  correction  must  be 
applied  to  WAt  to  reflect  the  effect  of  earth  rate.  This  is 
necessary  since  the  angular  rate  sensors  measure  the  vehicle's 
motion  with  respect  to  inertial  space,  whereas  the  C-matrix 
gives  the  vehicle's  attitude  with  respect  to  the  local  frame 
which,  in  turn,  is  rotating.  For  the  earth  spin  rate  ft  and 
latitude  L,  the  NAV  (local)  frame  components  are  ft  cos  L,  0, 
and  -ft  sin  L.  Premultiplying  these  components  by  the  trans- 
N 

pose  of  the  Cv  matrix  then  gives  the  earth  rate  effect  as 

seen  by  the  vehicle  axes.  Subtracting  from  the  measured  an¬ 
gular  rates  will  give  the  net  rates  (or  increments)  with 
respect  to  the  NAV  frame. 

Some  42  multiplications  per  sample  are  indicated  for  the 
foregoing  procedures.  Assuming  200  usee  per  32-bit  multipli¬ 
cation,  a  10  msec  sampling  period  should  allow  sufficient  time 
for  computation.  A  hardware  multiplier  can  always  be  used  for 
faster  execution,  if  necessary,  at  a  small  (<  $200)  additional 
cost . 
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APPENDIX  B.— ALTERNATE  ALGORITHMS 


The  computational  procedure  described  in  Appendix  A  is 
fairly  conventional  for  "strap-down"  inertial  systems.  When 
so  desired,  ground  speed  information  may  be  combined  with  at¬ 
titude  to  calculate  position.  If  display  of  heading  only  is 
the  ultimate  objective,  then  computation  of  heading  may  be 
performed  relatively  inaccurately  and  infrequently.  However, 
the  underlying  attitude  matrix  must  be  updated  with  precision. 
A  tradeoff  may  be  implemented  wherein  the  chore  of  matrix  up¬ 
dating  is  simplified  at  the  expense  of  a  more  complex  heading 
calculation. 

The  C-matrix  is  now  chosen  to  describe  the  vehicle  at¬ 
titude  with  respect  to  inertial  space,  Cy.  Updating  of  this 

matrix  from  the  measured  angular  increments  requires  no  prior 
correction  for  earth  rate,  thus  eliminating  the  multiplication 

M 

involving  the  transpose  of  Cy.  Only  when  a  heading  calcula¬ 
tion  is  to  be  performed  is  an  additional  coordinate  rotation 
required. 

In  one  version  of  this  approach,  the  inertial  axes  are 
selected  to  coincide  with  the  local  navigation  frame  at  the 
start  of  a  mission,  simplifying  the  initialization  procedure. 

Accurate  updating  of  the  Cy  matrix  from  the  angular  increment 

readouts  proceeds  every  sampling  instant.  When  at  any  time  t 
it  is  desired  to  compute  heading,  it  is  first  necessary  to 
N 

compute  Cj  ( inertial-to-navigational )  matrix  at  that  time. 

The  change  of  attitude  of  the  navigational  frame  in  inertial 
space  over  the  time  t  may  be  visualized  as  a  succession  of 
three  rotations: 

(1)  rotation  +L  deg  about  Y  axis  (pitch  up) 

(2)  rotate  +nt  about  new  X  axis 

(3)  rotate  -L  deg  about  new  Y  axis  (pitch  down) 

(L  is  latitude  and  fl  is  the  earth  spin  rate.) 

The  product  of  the  corresponding  rotation  matrices  gives  the 
matrix  cj.  The  elements  C^,  c21 ,  and  C31  of  the  Cy  matrix 
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form  a  vector  describing  the  direction  of  the  vehicle's  longi¬ 
tudinal  axis  with  respect  to  the  inertial  frame.  When  pre- 

multiplying  by  C ^ ,  the  components  with  respect  to  the  navi¬ 
gational  frame  are  obtained,  from  which  heading  may  be 
calculated  in  the  usual  manner. 

An  even  great  simplification  may  be  obtained  at  the  cost 
of  greater  complexity  in  the  initial  alignment  procedure. 
Earth-aligned  inertial  axes  are  chosen: 

X  -  directed  toward  and  perpendicular  to  the  earth's 
axis. 

Y  -  east 

Z  -  parallel  to  negative  spin  axis 

(X  and  Y  lie  in  a  plane  parallel  to  the  equatorial  plane.) 

Only  two  rotations  are  needed  to  transform  from  this  inertial 
frame  to  the  local  NAV  frame: 

(1)  rotate  -fit  about  the  Z  axis 

(2)  rotate  (90  deg-L)  about  the  new  Y  axis 

The  calculation  of  heading  proceeds  as  before. 

These  procedures  have  merit  only  if  heading  is  to  be  cal¬ 
culated  infrequently.  If  position  navigation  is  required, 
continuous  updating  of  heading  may  be  needed  to  minimize  er¬ 
rors,  in  which  case  the  use  of  inertial  frames  would  be  of  no 
benefit . 
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APPENDIX  C.— "PRECISION"  MATRIX  UPDATING  USED  IN  SECTION  3, 
30DY  OF  REPORT 


The  computer  program  described  in  Section  3  attempts  to 
eliminate  computational  errors  so  that  the  heading  errors  ob¬ 
tained  are  due  solely  to  angular  rate  sensor  errors.  One  ef¬ 
fect  of  the  quantizing  of  input  motion  is  to  allow  for  a  more 
time-consuming  but  highly  precise  updating. 

Given  the  three  angular  increments  between  sampling  in¬ 
stants,  the  microprocessor-based  algorithm  is  described  by 
equation  (4),  Appendix  A: 


C 


n+1 


+  W  t  + 


(WAt)2 3 

2 


With  a  large-scale  computer  available,  a  closed-form  solution 
may  be  utilized  for  the  above  infinite  series: 


:n+l  Cn  ^  ’ 


where  the  elements  of  0  are 


*n  '  £  *  6 


>12  »  '-f-  sis  S  +  (i  .  cos  6) 

6 


♦  13  -  sin  S  +  --■§£  (1  -  cos  S) 


021  =  sin  g  +  Ax  &  (1  -  cos  S) 

3  8 2 


2  2  2 

<ti  -A y_  ,  AZ  +  Ax  .  .  _  „ 

22  2  - 5 -  cos  3 

3  3“ 
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o23  =  -  — |  sin  3  +  (1  -  cos  3 

3 


_  -Ay  .  Ax  Az  _ 

$32  *  +  — “2~~  (1  -  cos  3) 

3 


>32  •  sin  !  .  42^2  (1  -  cos  6) 

8 


>33  -  ^4  +'Ar2-yx2  <=°s  s 

^  S“  s2 


52  *  Ax2  +  Ay2  +  Az2  . 


N 

) 


A  more  convenient,  equivalent  form  is  obtained  for  the 
computer  updating  via  the  following  steps1: 

B2  -  Ax2  +  Ay2  +  Az2 

0  -  V  S2 

<3  -  sin  3 

S  S 

Q  ,  1  -cos-3 
32 

4>n  =  i  -  Q(Ay2  +  az2) 

$12  *  Q  Ax  Az  -  SAz 
$13  *  Q  Ax  Az  +  SAy 


W.  F.  Ball,  "Strapdown  Analysis,  Part  4,  Gyro  Modelling  and 
Gyro  Storage  Error,”  Naval  Ordnance  Test  Station  Technical  Note 
404-38,  15  June  1966. 
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=  Q  Ax  Ay  +  SAz 
4>22  =  1  -  Q(Ax2  +  Az2) 
4> 23  -  Q  Ax  Az  -  SAx 
4> =  Q  Ax  Az  -  SAy 
$22  =  Q  Ay  Az  +  SAx 
$33  =  1  -  Q(Ax2  +  Ay2) 


For  each  update  to  be  performed,  the  $  matrix  is  developed 
from  the  three  angular  increments  in  a  subroutine.  The  pre¬ 
vious  C-matrix  is  then  multiplied  by  the  4>  matrix  to  obtain 
the  updated  C-matrix. 
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APPENDIX  D.— CONING  MOTION  AND  ITS  SIGNIFICANCE 


This  section  discusses  some  aspects  of  coning  motion 
with  a  view  towards  understanding  its  impact  on  attitude 
creep,  computer  simulation,  and  processing  requirements. 

The  term  "coning"  derives  from  the  fact  that  if  two 
axes  are  subjected  to  sinusoidal  motion  of  equal  amplitude 
and  frequency  but  90  deg  out  of  phase,  the  third  axis  des¬ 
cribes  a  cone  in  space.  In  general,  any  combination  of 
motion  about  two  axes  will  result  in  changes  of  orienta¬ 
tion  about  all  three  axes.  The  computer's  function  is  to 
accurately  track  this  changing  attitude. 

Sequential  Pitch  and  Roll 

Some  insight  may  be  obtained  by  examining  the  effect  of 
sequential  pitch  and  roll  operations.  For  a  rotation  0  about 
any  axis,  the  corresponding  transformation  matrix  contains  1, 
cos  9,  cos  0  in  the  main  diagonal.  Sin  0  and  -sin  0  appear 
once  in  symmetrical  off-diagonal  positions,  with  zero  in  the 
remaining  positions.  Rotation  in  the  opposite  direction  (-0) 
results  in  the  identical  matrix  except  for  a  change  of  sign 
in  the  sine  terms,  equivalent  to  the  transpose  of  the  orig¬ 
inal  matrix.  Fence,  if  P  is  the  rotation  matrix  for  a  pitch 
of  9  and  R  is  the  rotation  matrix  for  a  roll  of  0,  the  se¬ 
quence  of  pitch  +0,  roll  +9,  roll  -0,  and  pitch  -0  is  given 
by 


P^RTRP  =  PTIP  »  I  (unity  matrix)  , 


and  we  return  to  the  starting  position.  This  is  motion  where 
the  Z  axis  retraces  its  path.  If  there  is  any  misalignment 
in  the  C-matrix  to  begin  with,  its  errors  remain  undisturbed. 

If  the  Z  axis  does  not  retrace  its  path,  such  as  in  the 
sequence  pitch  +9,  roll  +9,  pitch  -0,  roll  -9,  a  net  change 
in  attitude  occurs.  (This  should  be  intuitively  obvious, 
since  the  positive  and  negative  rotations  are  made  about 
axes  whose  spatial  orientation  are  different).  The  sequence 
of  +pitch  and  +roll  is  given  by 
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RP 


. 

cos 

9 

sin 

•  I 

\ " 

-sin 

9 

cos 

•/' 

/  cos  9 

0 

|  sin29 

cos 

9 

\  sin  9 

cos 

9 

-sin 

9 

-sin  9 

sin  9  cos  9 

2  . 
cos  9 


-sin  9 
0 

cos  9 


The  sequence  of  -pitch  and  -roll  is  as  above  but  with  -9  sub¬ 
stituted  for  +9.  The  resulting  matrix  is  post  multiplied  by 
RP  to  obtain  the  final  transformation  matrix.  When  this  is 
done,  the  following  terms  of  interest  result: 


2  2 

*  cos  9  +  sin  9  cos  9 
C12  =  -sin29 


2  4 

C33  =  2  sin  9  cos  9  +  cos  9 

-1  ^12 

For  9  =  5  deg,  a  change  of  heading  (tan  ■= — )  of  0.435  deg 

11  -1 

is  obtained.  A  very  small  change  of  tilt  (cos  <-33)  of 

0.027  deg  also  results.  Note  that,  in  this  case,  if  the 
C-matrix  is  misaligned  to  begin  with,  the  computer  will  cal¬ 
culate  net  motion  about  an  axis  whose  orientation  is  in 
error  (even  with  perfect  calculation).  Hence,  errors  can 
grow  as  a  result. 

The  motion  about  the  third  axis  is  real  motion,  the  re¬ 
sult  of  stipulated  motion  about  the  other  axes.  Much  of  the 
literature  assumes,  as  a  condition,  that  there  is  no  cumula¬ 
tive  motion  about  the  third  axis.  Coning  is  then  interpreted 
as  that  compensating  axis  rotation  (z  in  this  case)  which 
would  keep  the  heading  constant. 
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Coning  Theorem 

1 

A  very  useful  theorem  states  that  if  some  motion  brings 
an  axis  (say  Z)  back  into  coincidence  with  its  starting  posi¬ 
tion,  a  Z  rotation  will  have  been  experienced  equal  to  the 
solid  angle  swept  out  by  the  Z  axis.  This  rotation  in  addi¬ 
tion  to  any  rotation  due  to  the  integral  of  zdt .  A  simple 
demonstration  is  to  allow  a  level  vehicle  to  pitch  up  90  deg, 
roll  90  deg,  and  pitch  down  90  deg.  The  vehicle  undergoes  a 
heading  change  of  90  deg  with  no  sensed  Z  axis  rotation  what¬ 
soever.  Applying  the  theorem,  the  Z  axis  returns  to  its 
original  orientation  after  sweeping  out  1/8  of  a  sphere  or 

^sr  radians. 


For  the  coning  motion  test  of  Appendix  G,  the  Z  axis 
sweeps  out  a  cone  of  half  angle  36.85  deg  five  times,  while 
the  heading  rotates  360  deg.  The  solid  angle  per  sweep  is 
2ir(l  -  cos  36.85  deg)  *  0.4ir.  A  full  rotation  of  2tt  there¬ 
fore  requires  five  such  conical  sweeps. 

For  the  5  deg  pitch  and  roll  example  of  this  section,  a 
5  deg  x  5  deg  square  is  swept  out.  If  the  slight  misalign¬ 
ment  of  the  Z  axis  after  one  cycle  is  neglected,  the  approxi- 

25  180 

mate  solid  angle  is  3353  x  *  0.435  deg,  in  agreement  with 
the  previous  calculation  of  heading  change. 

Significance  for  Computer  Simulation 

The  "creep"  of  heading  and  tilt  for  the  vehicle  scenar¬ 
ios  of  Sections  3  and  4  may  be  understood  as  coning  effects 
resulting  from  a  stipulation  of  3-axis  motion.  The  input 
motion  of  Section  3  is  due  to  irregular  quantizing  of  the 
underlying  sine  wave  inputs.  This  irregularity  destroys 
the  compensating  effects  of  the  scenarios  of  Section  4, 
leading  to  greater  magnitudes  of  creep. 

The  received  plots  of  pitch  and  roll  for  vehicle  test 
runs  show  an  in-phase  relationship.  Assuming  that  such  a 
phase  relationship  is  not  universal  and  knowing  that  quadra¬ 
ture  effects  are  more  severe,  some  of  the  runs  were  changed 
to  reflect  pitch  and  roll  inputs  of  slightly  different  fre¬ 
quencies.  Hence,  all  phase  relationships  are  experienced. 

The  results  indeed  show  greater  perturbations  for  the  latter 
inputs. 


lGoodman  and  Robinson,  "Effects  of  Finite  Rotations  on 
Gyroscopic  Devices,"  Journal  of  Applied  Mechanics,  June  1958, 
pp.  210-213. 
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The  plots  of  heading  for  the  simulations  of  Section  4 
are  based  on  pure  sine  wave  inputs,  again  with  slightly  dif¬ 
fering  pitch  and  roll  frequencies.  The  effect  on  heading 
is  clearly  seen  during  the  periods  of  no  yaw  (e.g.,  200  to 
600  sec.).  As  the  phase  between  pitch  and  roll  changes 
steadily,  the  heading  drift  changes  direction,  producing 
the  beat  pattern  seen. 

It  must  be  emphasized  that  the  foregoing  effects  des¬ 
cribe  real  motion  which  must  result  if  the  3-axis  inputs 
are  as  specified.  What  is  principally  of  concern  is  the 
ability  of  the  system's  output  to  properly  define  the 
attitude . 

Significance  for  Sampling  Interval 

It  has  previously  been  mentioned  that  the  computation 
algorithm  is  a  "constant  velocity"  algorithm.  To  the  ex¬ 
tent  that  velocity  is  not  constant  between  updates,  some 
error  will  be  introduced.  It  naturally  follows  that  the 
maximum  acceptable  sampling  interval  is  dependent  on  vehicle 
angular  acceleration.  If  it  is  assumed  that  continuous  con¬ 
ing  motion  due  to  pitch  and  roll  represents  a  severe  test,  a 
simple  intuitive  estimation  of  drift  may  be  made  with  the 
aid  of  the  coning  theorem. 

Assume  a  worst  case  of  quadrature  motion.  For  equal 
amplitude  pitch  and  roll,  the  Z-axis  describes  a  cone,  as 
shown  in  Figure  D-l.  The  period  of  this  sweep  equals  the 
pitch  roll  period.  The  half-cone  angle  equals  the  pitch 
and  roll  amplitude. 


Figure  0-1  Conical  motion  of  Z-axis. 
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For  small  angles,  there  is  little  error  in  considering 
the  spherical  area  intercepted  by  the  cone  to  be  a  plane.  The 
solid  angle  swept  out  per  cycle  is  then  proportional  to  the 

2 

area  of  the  plane  circle  (irR  ).  The  processor,  however,  as¬ 
sumes  that  the  Z  axis  describes  segments  of  the  circle  accord¬ 
ing  to  the  sampling  interval.  It  is  assumed  that  the  angular 
rate  sensors  are  not  sampled.  Their  outputs  are  continuously 
fed  into  integrators  and  it  is  the  integrators  which  are  period¬ 
ically  sampled.  Hence,  the  angular  position  read  at  each  sample 
is  correct  but  the  constant  velocity  algorithm  assumes  that  the 
new  position  was  attained  via  constant  angular  rate  of  the  X 
and  Y  axes.  The  vehicle  is  thus  thought  to  have  rotated  about 
a  fixed  axis  in  the  X-Y  plane.  With  no  additional  computation 
errors,  a  vehicle  rotation  about  the  Z  axis  will  be  calculated 
proportional  to  the  area  represented  by  the  sum  of  the  segments 
of  the  circle  rather  than  the  circle  itself. 

The  area  per  segment  is 


A  =  R  sin  a 


It 

R  cos  a  =  ^—  sin  2a 


For  N  segments  per  circle, 

„  _  2n 

a  sw 

and  the  total  area  of  N  segments  is 

f -ve(|i)3]. 

The  second  term  within  the  brackets  represents  the  departure 
from  the  area  of  the  circle.  The  fractional  error  is 

3  2 

Fractional  error  ■  (^ )  *  1/6  x  *  1/6  (^  ) 


NA 


NR2_,_  2tt  »  NR2 
-2~sin  IT  T“ 
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Now,  according  to  the  coning  theorem,  the  Z-axis  rota- 

2 

tion  equals  the  solid  angle  swept  out  by  the  Z  axis  =s  t0 
per  cycle.  The  processor  error  is  then 


s  *  TT02  x  1/6  =  2/3  *3  K  per  cycle 


If  Tp  *  pitch  and  roll  period  and  Tg  *  sampling  period: 


x  radians/sec. 
P 


In  terms  of  9  degrees  and  error  rate  in  degrees/hour, 


O 

error  rate  =  1290  — *■  Ts  deg/hr. 

T 

P 


Measured  data  indicate  pitch  and  roll  amplitudes  of  3  deg 
with  a  period  of  1.5  seconds.  Then 


2 

error  rate  =  3400  T  deg/ hr. 

s 


A  sampling  interval  of  0.1  s  is  clearly  insufficient.  At 
0.01  s,  the  error  is  reduced  to  0.34  deg  per  hour.  The 
input  motion  is,  of  course,  exceptionally  severe  since  a 
constant  90  deg  phase  relationship  between  pitch  and  roll 
is  assumed. 


T 

N  =  ^ 
s 


error  rate  ■  2/3  tt 


-  92T  2 
3  s 
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APPENDIX  E . —PROGRAM  LISTING  FOR  SECTION  3,  BODY  OF  REPORT 


The  results  of  Section  3  were  obtained  with  the  following 
computer  program,  LNDNAV.  The  listing  shows  a  particular  choice 
of  input  parameters  which,  of  course,  are  changed  to  accommodate 
the  various  vehicle  scenarios.  The  notation  AMP(3,2)  refers  to 
the  Z-axis  amplitude  during  the  second  interval.  FREQ(1,4)  is 
the  period  of  the  X-axis  motion  during  the  fourth  interval.  Tl, 
T2,  T3,  and  T4  give  the  time  at  the  end  of  each  interval. 

In  the  listing  shown,  some  of  the  constants  were  preselected 
even  though  the  ability  of  the  operator  to  insert  these  constants 
in  response  to  computer  prompting  is  preserved. 
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APPENDIX  F.—  PRINTOUTS  FOR  SECTION  3 


Printouts  for  a  number  of  cases  discussed  in  Section  3 
shown.  These  correspond  to  cases  3.4.2e,  3.4.2g,  3.4.3, 
4(d),  3.4.5(b),  and  3.4.6  of  that  section. 
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APPENDIX  G.— CHECK  ON  ACCURACY  OF  REFERENCE  ALGORITHM 


In  the  study  of  computation  algorithms  (Section  4),  the 
"error"  is  simply  the  difference  between  a  particular  algo¬ 
rithm's  output  and  that  of  the  "reference"  algorithm.  A  nag¬ 
ging  question  remains  as  to  the  sufficiency  of  the  reference 
algorithm.  A  precise  mathematical  solution  for  any  but  ex¬ 
tremely  simple  input  motion  is  beyond  reach. 

One  source  of  confidence  is,  of  course,  the  small  errors 
between  the  reference  and  the  best  of  the  test  algorithms. 

An  additional  check  on  the  reference  algorithm  was  made 
utilizing  the  mathematical  formulation  of  attitude  as  a  result 
of  coning  motion.  This  formulation  is  found  in  the  literature1. 
Coning  motion  is  the  result  of  quadrature  motion  on  two  of  the 
axes,  a  motion  which  presents  a  most  difficult  test  of  computation 
adequacy . 

For  X  and  Y  axis  motion  given  by 
x  ==  A  sin  Bt 
y  »  A  cos  Bt 


the  C-matrix  components  C11  and  C21  at  any  time  t  may  be 
expressed  as 


C11  *  5E  KB+R)  cos  (R-R)t  “  (B-R)  cos  (B+R)t ] 


C21  "  T1  sln  Bt  +  -ny  1<®-R>  sin  (B+R)t  +  (B+R)sin(B-R)t]  . 
R  2R 


A  suitable  choice  of  A  and  B  which  makes  the  arithmetic 
simple,  while  giving  a  severe  but  practical  test  is  A  *  0.15V 
and  B  a  0.2ir.  Then  C^  and  C12  reduce  to 


Cll  *  0.9  cos  0.05  irt  +  0.2  cos  0.45  irt 


- 1 - 

A. A.  Sutherland,  Jr.  and  P.  0.  Bongiovanni,  "Data  Smoothing 
for  Enhancement  of  Strapdown  Inertial  System  Accuracy:  Inter- 
polative-Predictive  Algorithms,"  Analytic  Sciences  Corp.  Report 
TR-155-1 ,  31  August  1969. 
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C31  3  0.36  sin  0.2  irt  -  0.08  sin  0.45  irt 


-  0.72  sin  0.05  irt 


The  period  of  this  motion  is  40  s.  At  t  *  10  s,  C11  *  0  for  a 

heading  of  90  deg,  while  at  t  3  20,  3  0  and  the  heading  is 

180  deg. 

This  motion  was  used  to  test  the  "reference"  algorithm 
and  confirmed  precise  agreement  with  the  theoretical  results. 

NOTE  . 

Since  the  program  was  written  in  terms  of  angle  rather 

than  rate,  the  rates  x  and  y  must  be  integrated  to  obtain 
the  proper  input. 

x  3  -  g  cos  Bt  +  g  . 


y  3  g  sin  Bt  . 

A 

The  constant  of  integration  g  must  be  added  to  x  so  that 

x(0)  3  0,  since  the  expressions  for  the  C-matrix  elements 
assume  initial  alignment  (identify  matrix)  at  the  start. 

It  is,  in  fact,  this  initial  alignment  which  makes  the  equa¬ 
tions  complex,  since  coning  takes  place  about  an  axis  offset 
from  the  vertical. 

As  a  matter  of  interest,  the  tilt  angle  9  of  the  Z  axis 
is  given  by 


cos  9  3  C33  3  1  - g  (1  -  cos  Rt) 

R 


0.64  +  0.36  cos  0.25  irt 


This  describes  conical  motion  with  9max  3  74  deg  and  a  period 

of  8  s.  Hence,  five  complete  cones  are  swept  out  by  the  Z 
axis  during  the  40  seconds  it  takes  for  the  heading  to  make 
one  complete  revolution. 


106 


TM«  JOHNS  HOSKINS  UNI  VSRSITY 

APPLIED  PHYSICS  LABORATORY 

ouscl  uanviano 


APPENDIX  H.—  PROGRAM  LISTING  FOR  SECTION  4 


The  results  of  Section  4  were  obtained  with  the  following 
computer  programs: 

a)  TNKSIM  calculates  the  reference  heading  and  tilt 
angles  and  develops  the  record  of  angle  increments 
which  would  be  measured  by  the  vehicle-mounted 
sensors.  Earth  rotation  is  accounted  for  in  these 
outputs. 

b)  TNKTST  models  the  anticipated  microprocessor-based 
system,  including  a  pulse-balanced  integrator  as 
the  analog-to-digital  device. 
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